(12) INTERNATIONAL APPLICATION PUBLISHED UNDER THE PATENT COOPERATION TREATY (PCT) 



( 1 9) World 1 ntellectual Property Organization 

International Bureau 

(43) International Publication Date 
16 May 2002 (16.05.2002) 




PCT 



(10) International Publication Number 

WO 02/39063 Al 



(51) International Patent Classification 7 



(21) International Application Number: PCT/SE0 1/02477 

(22) International Filing Date: 

8 November 2001 (08.1 1.2001) 



(25) Filing Language: 



(26) Publication Language: 



(30) Priority Data: 
0004096-4 



8 November 2000 (08. 1 1 .2000) SE 



(71) Applicant (for all designated States except US): NIRA 
DYNAMICS AB [SE/SE]; Mjardevi Science Park, 
Teknikringen IF, S-583 30 Linkoping (SE). 



G0IC 21/30 (74) Agents: KITZLER, Michael et al.; do Albihns Malmo" 
AB, P.O. Box 4289, S-203 14 Malmo (SE). 

(81) Designated States (national): AE, AG, AL, AM, AT, AU, 
AZ, BA, BB, BG, BR, BY, BZ, CA, CH, CN, CO, CR, CU, 
CZ, DE, DK, DM, DZ, EC, EE, ES, FI, GB, GD, GE, GH, 
GM, HR, HU, ID, IL, IN, IS, JP, KE, KG, KP, KR, KZ, LC, 
LK, LR, LS, LT, LU, LV, MA, MD, MG, MK, MN. MW, 
MX, MZ, NO, NZ, PL, PT, RO, RU, SD, SE, SG, SI, SK, 
SL, TJ, TM, TR, TT, TZ, UA, UG, US, UZ, VN, YU, ZA, 
ZW. 

(84) Designated States (regional): ARIPO patent (GH, GM, 
KE, LS, MW, MZ, SD, SL, SZ, TZ, UG, ZW), Eurasian 
patent (AM, AZ, BY, KG, KZ, MD, RU, TJ, TM), European 
patent (AT, BE, CH, CY, DE, DK, ES, FI, FR, GB, GR, IE, 
IT, LU, MC, NL, PT, SE, TR), OAPI patent (BF, BJ, CF, 
CG, CI, CM, GA, GN, GQ, GW, ML, MR, KB, SN, TD, 
TG). 



English 



English 



(72) Inventors; and 

(75) Inventors/Applicants (for US only): FORSSELL, Ur- 
ban [SE/SE]; Farsaxvagen 49, S-586 66 Linkoping (SE). 
HALL, Peter [SE/SE]; Fanjunkaregatan 126, SE-582 16 
Linkoping (SE). GUSTAFSSON, Fredrik [SE/SE]; OG 
Svenssons vag 26, S-590 71 Ljungsbro (SE). 



Published: 

— with international search report 

For two-letter codes and other abbreviations, refer to the "Guid- 
ance Notes on Codes and Abbreviations" appearing at the begin- 
ning of each regular issue of the PCT Gazette. 



(54) Title: MAP-AIDED POSITIONING 



20 



INERTIAL AND 
RELATIVE 
POSITION SENSORS 



22 

v. 



■ T 

GPS/GSM/RDS 



23 



O 

ON 

is 
© 

o 




27 



MAP DATABASE 



25 



POSITIONING 
ALGORITHM 



26 



' i 

i 

. 4 



DATABASE HANDLING 



28 



i 



/ 



18 



30 



29 



POSITION 
ESTIMATE 



(57) Abstract: The present invention concerns a map-aided positioning system for a movable object wherein digital map informa- 
tion and information from state characteristic sensors of the movable object is used in a filtering procedure that based on an initial 
position indication repeatedly during the movement of the movable object calculates position estimate candidates and a continuously 
improved position estimate. 
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MAP-AIDED POSITIONING 

Field of the invention 

The present invention relates to a method and a system for positioning of a 
5 moveable object. More specifically, the invention relates to a map-aided positioning 

system wherein map information and relative position information is combined to estimate 
an absolute position indication. 

Background 

10 Today's positioning and navigation systems for vehicles almost exclusively rely on 

external position information such as satellite information obtained from a GPS (Global 
Positioning System) receiver, or similar, in combination with digital map information 
stored in a read-only memory (ROM) such as a CD or DVD ROM. These types of systems 
have been in use for a number of years now and are starting to expand their market share 

1 5 considerably. A driving force is the increased possibilities to remotely communicate with 
the vehicle using mobile telephony and other wireless communication channels. However, 
positioning is not only used for navigation, i.e. to find the shortest or fastest way to a 
destination, it is also the backbone of other emerging services such as post crash alarms, 
anti-theft tracking devices and "yellow-pages" services, the latter services providing 

20 answers to questions such as "Where is the nearest repair shop?" and the like. 

The satellite-based systems of today are not ideal, especially not in urban areas with 
high buildings, multi-level highways, and tunnels where satellite coverage often are poor, 
and where the GPS-signals are corrupted by multi-path and fading. To enhance 
performance under these circumstances, the systems frequently feature dead reckoning 

25 capability, i.e. the systems use relative positioning information obtained from e.g. an 
inertial navigation system to predict future positions. However, despite these efforts to 
improve positioning accuracy, the performance of GPS based systems is sometimes 
surprisingly poor. Furthermore, GPS based systems typically show the worst performance 
when they are needed the most, for example in dense urban areas. 

30 A further feature of some prior art GPS-based positioning systems is the addition of 

map matching to enhance the precision e.g. when turning around sharp corners and 
following characteristic road patterns. In principle, map matching is about moving a 
symbol indicating the position of a vehicle on a map from a calculated position to the 
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nearest road found on the map. If done correctly this method can reduce the positioning 
error and also improve the user interface for example in terms of the user's perception of 
the positioning accuracy. A problem in many systems is however that the positioning and 
map-matching functions are not integrated and do not support each other, which sometimes 
5 results in sub-optimal performance. As an example, consider a case where the GPS signal 
is lost and the system relies on dead reckoning information only for a period of time. Since 
many current dead reckoning systems are rather simple and quite quickly accumulate 
errors, the calculated position may then deviate considerably from the true position on the 
road. Further, the map matching algorithm will try to match the calculated position to an 

10 assumed true position somewhere on the road network, which under these circumstances 
can result in a completely wrong indication of the true position or at least an indication that 
is delayed and tries to "catch up" with the true position but never reaches it. This type of 
weak performance is common in today's navigation systems. 

Another drawback is that a satellite receiver is a rather expensive component, which 

1 5 makes the complete system expensive. The overall cost is further boosted by the fact that 
the manufacturers only offer complete, pre-installed, and integrated systems with satellite 
receiver, CD player, microprocessor etc. all integrated to one built-in unit. This unit 
typically requires custom software and custom digital road maps, which are manufacturer 
dependent and cannot be re-used when you buy a new system from another supplier. 

20 Typically you cannot use the system in other vehicles or platforms than the one it is 
installed in either. So for example if you have two vehicles and want to use the same 
navigation system in both, this is impossible or at least complicated. 

Prior Art 

25 A GPS car navigation system is disclosed in US Patent No. 6,041.280 to 

Kohli et al. This system derives GPS position update information from motion of the car 
along the actual track. Turns along the track are detected when they actually occur and are 
compared with the predicted turns so that the time and position at the actual turn can be 
used to update the then current GPS derived position of the vehicle. The aim of this 

30 updating of position information with actual turn data is to improve the accuracy of the 
GPS navigation especially during single satellite navigation. 

Another piece of prior art map-matching navigation system is found in US Patent 
No. 5,774,824 to Streit et al. This system is designed for monitoring vehicle state 
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characteristics including the location of a vehicle on a map route. There are two operating 
modes, namely a fixed mode wherein the map route is inputted by a user or a flexible mode 
wherein the map matching navigation system determines the map route from a plurality of 
measured points which corresponds to the location of the vehicle. The map matching 
5 navigation system additionally updates the location of the vehicle at a plurality of positions 
on the map route wherein the vehicle location is known with an increased level of 
confidence. Furthermore, a system for terrain navigation using Bayesian estimation is 
known from "Recursive Bayesian Estimation: Navigation and Tracking Applications", 
Niclas Bergman, Ph.D. thesis, Linkoping University, 1999. The main result in Bergman's 
10 thesis is a navigation system for aerospace applications using terrain altitude information 
stored in a GIS (Geographical Information System) combined with altitude measurements 
from radar. 

Despite the efforts in prior art there is a need for a more accurate positioning 
system, that is less sensitive to a difficult topography. Furthermore, there is a need for a 
1 5 less costly and more versatile device for positioning. 

Object of the Invention 

It is therefore an overall object of the present invention to solve the problem of 
providing a positioning system for determining the position of a moveable object, the 
20 system providing an improved accuracy in positioning independent of the current 
topography. 

An aspect of the problem is to provide a positioning system that is readily 
implementable in a handy application device and that is suitable for use in different 
application areas, such as road vehicles, trains, robots, storehouse trucks and personal 
25 positioning needs. 

Another aspect of the problem is to provide such a system that has a high degree of 
availability and a relatively low cost. 

Summary of the Invention 

30 The invention is thus directed to a positioning system based on a combination of 

dead reckoning and map information, starting from an at least roughly determined initial 
estimate of a true position. The initial position parameters are input into a dead reckoning 
system that receives state characteristic information that represent state characteristic 
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parameters of a moveable object. The dead reckoning system gathers updated state 
characteristic information as the moveable object moves and calculates a dead reckoning 
position relative to the initial position estimate. The dead reckoning position information is 
then combined with map information, preferably in a digital form, and processed in a non- 
5 linear filter in order to give a resulting estimate of the true absolute position. 

The underlying idea of the present invention is to recursively estimate the 
conditional probability density for the position of a moveable object based on a 
measurement related to the object's position. The moveable object may for example be a 
vehicle, a boat, a robot or an instrument used in automatic surgery, and a description of the 

1 0 surroundings may thus be a road map, a marine chart or the like. In the following 

description text, the system and method according to the invention will for the sake of 
simplicity mostly be described with reference to a vehicle as the moveable object 

In another wording the present invention thus refers to a system that recursively 
estimates the conditional probability density for the vehicle's position using relative 

15 position information and a road map. The relative position information can preferably be 
obtained using dead reckoning using state characteristic indicators in the shape of wheel 
speed signals supported by inertial sensors such as accelerometers and yaw rate gyros. The 
recursive estimation of the conditional probability for the vehicle's position may for 
example be implemented using a non-linear filtering algorithm. 

20 In accordance with one aspect of the invention, digital map information and 

information from a dead reckoning system is used in a non-linear filtering algorithm, for 
example an adaptive filter, that preferably is based on Bayesian estimation principles. The 
dead reckoning system is preferably implemented in the shape of an inertial navigation 
system (INS) that is based on state characteristic parameter values derived from inertial 

25 sensors on the moveable object. 

In other aspects and embodiments the positioning algorithm can within the same 
conceptual framework also be implemented in other ways, for example based on a non- 
probabilistic reasoning. The invention is in the present description mainly explained from 
the point of view of a statistical approach. However, the inventive concept may also be 

30 implemented by means of artificial intelligence, fuzzy logic, neural networks and the like. 
According to another aspect, the invention is directed to achieve a positioning 
system for a cheap, flexible navigation system to be used in cities. This embodiment of the 
inventions operates with a fairly detailed map having many check possibilities in terms of a 
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dense street mesh. 

In another aspect the invention is directed to a positioning system configured to 
interact with GPS positioning in an improved GPS based navigation system. 
An embodiment of the inventive positioning method for determining the position of a 
5 moveable object, comprises the steps of: 

- receiving as an input an initial position indication; 

- receiving as an input topology information dependent on said initial position indication, 
said topology information including a plurality of possible position indications; 

- receiving as an input a moveable object state characteristic parameter value; 

10 - calculating a relative position indication relative to said initial position indication 
dependent on said moveable object state characteristic value; 

- generating a plurality of position estimate candidates dependent on a said possible 
position indications and on said relative position indication; 

- selecting a position estimate indication among the position estimate candidates and 
1 5 dependent on a predetermined selection rule. 

An apparatus or a system for implementing the inventive the mentioned 
method would inter alia comprise: 

- an input for an initial position indication; 

- an input for topology information dependent on said initial position indication, said' 
20 topology information including a plurality of possible position indications; 

- an input for a moveable object state characteristic parameter value; 

- a calculation stage configured to calculate a relative position indication relative to said 
initial position indication dependent on said moveable object state characteristic value; 

- a calculation stage configured to generate a plurality of position estimate candidates 
25 dependent on a said possible position indications and on said relative position indication; 

- a selection stage configured to select a position estimate indication among the position 
estimate candidates and dependent on a predetermined selection rule. 

In further specified developments of the invention the initial position is for 
example indicated as a limited geographical area; as an indication obtained from a 
30 wirelessly communicated positioning service or from a GPS receiver. The initial position 
may also be input manually or be obtained via a transponder situated at a fixed location. 

The topology information is preferably obtained from map information of a 
map information source, such as a map database stored on a data storage or is received 
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upon request from a remote a map source. 

The state characteristic parameter values are preferably received from a 

relative position sensor, such as a wheel speed sensor, or from an inertial sensor, such as a 

yaw rate sensor or accelerometer, of the movable object. 
5 The relative position indication is for example calculated as the distance 

and/or the direction the movable object has moved from the initial position indication. 

The inventive method is in operation iteratively repeating the estimation 

steps, for example such that inter alia the generation of position estimate candidates 

comprises the step of repeatedly selecting a limited set among current position estimate 
10 candidates. The generation of position estimate candidates may also comprise the step of 

randomly selecting position candidates. 

The selection or calculation rule for determining the position estimate 

indication is for example selected as the position estimate candidate having the shortest 

distance from one of the currently possible position indications. In preferred embodiments 
15 the position estimate is determined by means of an adaptive filter, recursively improving 

the position estimate candidates and the position estimate during operation along with the 

movement of the movable object. 

The invention is applicable in different movable objects, for example in a 

wheeled vehicle, a track vehicle, such as a train or tram, a storage house truck, an 
20 aeroplane, a boat, a surgical instrument, such as an endoscope or any other object that has 

an operating area in which a position should be determined or controlled. For each of the 

various moving objects, a correspondingly suitable description of the topology in which the 

movable object moves or operates as well as" suitable state characteristic value sensors have 

to be provided. So for example, when applying the invention in a boat the topology 
25 description can be a map of the sea bottom and the state characteristic sensors can be a boat 

dead reckoning sensor and an echo sensor for detecting the current bottom topography 

under the boat. Likewise, an assumption limiting the set of possible positions have to be 

determined. 

The invention can be combined with other systems, for example such that it 
30 is configured to implement map-matching in a GPS based positioning/navigation system; 
configured to implement vehicle positioning using Mobile Positioning Services (MPS); or 
configured to monitor the performance of a GPS based navigation system. Furthermore, the 
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invention can be applied in monitoring various sensors, such as an INS preferably a gyro 
or an accelerometer, or an DRS sensor, preferably the wheel speeds. 
The invention can also be used to monitor other parameters such as the absolute vehicle 
speed (t ex for att kolla hastighetsrnataren) or the different tire pressures (kopplat till 
5 funktionen hos DRS) . 

A computer program product realising the invention would comprise 
computer program code portions configured to direct a data processing system to perform 
the steps and functions of the inventive method or system. 



10 Advantages 

An advantage with the invention is that the positioning works accurately in a 
difficult topography, for example near high-rises and in tunnels, where for example GPS- 
dependent positioning performs poorly. The use of relatively simple hardware also entails 
that the invention enables the manufacturing of cheaper positioning and navigation 
15 equipment. 

Definitions 

In the present description the following expressions are used to describe the 
invention. 

20 Map information: The map information is in the present invention taken to be a 

description of the topology or the topography in an area in which the position of a movable 
object is to be determined. The map information are in different embodiments and 
dependent on the application a 2-dimensional or a 3-dimensionaI representation of the 
topography. Furthermore, the map information is preferably represented in a digital format 

25 or is digitised when used in order to allow digital data processing when calculating a 
positioning estimate. 

Moveable object: The present positioning system is applicable in determining the 
position of a moveable or moving object. The moveable object can for example be a road 
vehicle such as a car, a lorry or a motorcycle, a track bound vehicle such as a train, a cross- 
30 country vehicle, a boat, a lawn mower, a robot, a storehouse truck, a surgery instrument, or 
a portable positioning device attached to an animal or held by a human user. 
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Navigation: Navigation is in the present text understood to concern the from 

some point of view optimal path from a position A to a position B, where optimal for 
example can be the nearest or fastest path. 

Positioning: Positioning is in the present text understood to concern 

5 determining a position in relation to a fixed reference. 

Brief Description of the Drawings 

The present invention will be explained in more detail with reference to the 
accompanying drawing, in which: 
10 Fig 1 A shows a structural overview of a positioning system in accordance with the 
invention; 

Fig IB shows schematically a functional block diagram of an embodiment of a position 
estimate calculator in accordance with the invention; 

Fig 1C shows schematically a vehicle positioning system according to an embodiment of 
15 the invention; 

Fig 2 shows a schematic flow chart of steps and functions comprised in an embodiment of 
the invention; 

Fig 3 and Fig 4 show schematic flow charts of steps and functions comprised in 
embodiments of the invention; and 
20 Fig 5A-5C shows and example of a positioning sequence performed in accordance with the 
invention. 

Detailed Description of Embodiments 

25 General Navigation System Configuration 

Fig 1 A shows schematically the structure of a navigation system including a 
positioning system 1 for determining the position of a moveable object according to an 
embodiment of the invention. In Fig 1 A the structure is described as a three-layer model 
comprising an infrastructure layer 2. a low-level application layer 4 and a high-level 
30 application layer 6. The infrastructure layer 2 comprises hardware 8 for executing and 
interfacing the low-level and high-level applications of the application layers 4 and 6, • 
hardware for running various software applications and for displaying positioning and 
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navigation information to a user. The hardware 8 thus typically includes a central 
processing unit (CPU), input/output devises (I/O), a presentation display, a keyboard or the 
like. A further developed embodiment of the infrastructure layer 2 further comprises a GPS 
antenna and receiver 10 that delivers GPS position information. The infrastructure layer 
5 also includes sensors 12 to determine a state characteristic of a moving object, the sensors 
being already existing or application specific sensors. The state characteristic sensors 
includes in different embodiments for example relative position sensors, such as wheel 
speed and steering wheel sensors in a vehicle, or inertial sensors such as yaw rate gyros or 
accelerometers. Further, the mfrastructure layer comprises a map database, for example in 

10 the shape of a read-only-memory such as CD ROM, DVD ROM or some other kind of 
storage. In some embodiments the map database information is available through some 
other source, for example conveyed to the positioning system through wired or wireless 
telecommunication. For this and different other functional reasons the infrastructure layer 
can also comprise a wired or wireless telecommunication device 16, for example a GSM 

1 5 (Global System of Mobile communication) or a GPRS (General Packet Radio System) 
telecommunication unit. 

The low-level application layer 4 comprises different functional low-level 
applications such as positioning functions, database functions and HMI (human machine 
interface) functionality. The positioning functions are devised or configured to calculate an 

20 estimate of a true position dependent on state characteristic parameters derived from 
signals from the state characteristic sensors available in the infrastructure layer 2. As 
mentioned above these state characteristic parameters are determined or detected for 
example by means of GPS, relative position sensors and inertial sensors. The database 
functions are typically realised in software configured to perform efficient map handling 

25 operating on map information stored in a map database or other map information source. 
The HMI functionality comprises for example command menu systems, presentation of 
position information, map-matching functions and basic advanced navigation functions. 

The high-level application layer 6 comprises different functional high-level 
applications such as advanced navigation functionality, advanced HMI features and 

30 application specific services and functionality dependent on the application of the 

navigation system. The advanced navigation functionality can for example includes route 
planning or route guidance. The advanced HMI-features can for example include voice 
control, turn-by-turn voice guidance and different graphical presentation features. The 
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application specific services can for example in the vehicle application include SOS alarm 
functions, tracking functions for anti-theft or rescue purposes, and various so called M- 
commerce functions like directed advertisement and travel services including customised 
directions to hotels, points of interest, gas stations, repair shops etc. 
5 The present invention is mainly directed to functionality in the low-level 

application level configured to optimise the utilisation of information from all currently 
available information sources in the system, for example GSM, GPS, digital map, relative 
and inertial sensors, in order to determine a position with a high degree of accuracy. 

There are a number of different possible configurations of sensors and available 

1 0 topology information when realising a positioning method or system within the inventive 
concept. For example in a wheeled vehicle application of the invention, it is currently 
believed that a possible minimum configuration of the invention would comprise sensors 
or sensor signals from two wheel speed sensors detecting the wheel speed of two wheels at 
each end of a wheel axis, combined with topology information from a map representing the 

1 5 geographical area in which the vehicle moves. 

Calculation of Position Estimate 

The calculation of a position estimate, also called positioning, is in accordance with 
the invention, carried out by performing dead reckoning dependent on a state characteristic 
parameter and in relation to a known initial reference position and combining dead 

20 reckoning information with digital map information. Thus given an initial, possibly quite 
rough estimate of the position, a calculated true, absolute position is determined without 
any support from external position information sources such as GPS. However, 
embodiments of the invention are combined with a GPS initially and/or during operation. 
The state characteristic parameter is preferably taken from an inertial sensor mounted on 

25 the moveable object and forms together with dead reckoning calculation functionality an 
inertial navigation system (INS). The information from this inertial navigation system 
(INS) is then processed together with map information in a non-linear filtering algorithm. 
In preferred embodiments the filtering algorithm is based on Bayesian estimation 
principles. 

30 Fig IB shows an embodiment of a position estimation functionality 18 in 

accordance with the invention. A position estimation calculator 25 is via a state 
characteristic parameter input 21 communicatively coupled to sensors for determining state 
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characteristic parameters in the shape of inertial and/or relative position sensors 20 that are 
a part of a positioning device, have contact with or are mounted on or attached to the 
moveable object that is to be positioned. An initial position determiner 22, for example 
realised by means of a GPS receiver, a GSM unit or an RDS (Radio Data System), is in a 
5 similar manner communicatively coupled to the calculator via an initial reference position 
input 23. A map database 24, for example in the shape of a read-write memory such as a 
smart card possibly receiving wired or wire-less downloaded map information, or a read- 
only-memory such as a CD or DVD, configured to store digital map information is 
likewise communicatively coupled to the calculator via a map information input 27. 

10 The position estimation calculator 25 comprises a positioning algorithm processor 

26, preferably realised by means of a data processing system loaded with computer 
program code portions devised to direct the data processing system to perform a selected 
positioning algorithm. The calculator also comprises a map database handling functionality 
28, likewise preferably realised by means of a data processing system executing 

1 5 corresponding computer program code portions. The positioning algorithm 26 and the map 
database handler 28 are also communicatively coupled, or even closely integrated, to 
interact in iterations of a recursive positioning algorithm. When the calculator has 
determined an estimate of the position in accordance with the selected algorithm a position 
estimate 30 is output via a position estimate output 29. 

20 In one embodiment of the invention GSM positioning is used to determine an initial 

position. Thus, when starting the positioning system in a state where no current position 
indication is at hand or stored, the positioning system is via a GSM unit connected to a 
GSM positioning service offered by a mobile telephone operator. An initial position 
indication is determined in the form of a sector area in a mobile telephone cell, which gives 

25 a rough position estimate with an accuracy of nominally about 300-3000 meters from the 
true position. As an alternative an initial position indication can be manually input to 
establish an area from which the positioning system should start searching the position. 
Evidently other radio based services, e.g. RDS, or an initial GPS-position may also be used 
as an initial position input. Other conceivable sources for initial position indications are for 

30 example a point in a parking house for cars or busses, a garage or a repair shop, a toll 
station at a toll road, a fuel or energy loading station, or some other fixed point where the 
movable object in question passes. The positioning algorithm is thereby initialised, and as 
the positioning apparatus moves with a moveable object to be positioned state 
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characteristic parameter values are obtained from the state characteristic parameter sensors 
and updated repeatedly. Relative position information is repeatedly calculated by means of 
dead reckoning and dependent on the state characteristic parameter values. An absolute 
position estimate is determined or calculated by combining the relative position 
information with map information in the non-linear filtering algorithm. 

A variety of this embodiment is devised to be detachably connectable to for 
example a vehicle and its state characteristic sensors, and when detached be used for other 
purposes, for example as a portable positioning device for navigating in a delimited area. 
Yet another application of the invention is as a security device for example for skiers. The 
positioning device would then be initialised when passing a check point for example in 
connection to a ski lift, tracking the position in relation to a map of the ski piste area and 
continuously or upon actuation, for example in connection with an accident, transmit to a 
central receiver a radio message comprising the true position. 

In another embodiment of the invention the map-aided positioning is combined 
with GPS position information such that GPS information, dead reckoning results and map 
information is combined and statistically processed to achieve a statistically optimal 
position estimate. Loss of GPS information is handled automatically and a position 
estimate is calculated dependent on the best currently available information from several 
different sources. This embodiment of the invention thus constituting a further developed 
GPS positioning system is not dependent on flawless GPS information and is therefore 
capable to operate confidently in a difficult topography, such as a dense urban area, a 
tunnel and the like. This embodiment implemented as a product would typically comprise a 
software product including computer program code configured to direct a data processing 
system to implement the functionality and the algorithm of the invention. This software 
product takes inputs from a GPS, a dead reckoning system and a map database, and 
computes a position estimate. This embodiment is advantageously integrated in a 
navigation system and is then complemented with functionality for graphical 
representation, map matching, route planning and other similar functions. 

A Vehicle Positioning System 

The invention is in this section explained in terms of a vehicle positioning system. 
In accordance with the concept of the invention, an estimate for the position of a vehicle is 
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calculated by recursively estimating the conditional probability density for the position 
dependent on relative position information and digital map information. The relative 
position information is preferably obtained by means of dead reckoning using state 
characteristic parameter values taken from wheel speed sensor signals and inertial sensor 
5 signals such as accelerometers and yaw rate gyros. For the sake of simplicity, the relative 
and inertial sensors together with dead reckoning calculation algorithms will in this text 
sometimes be referred to as a dead reckoning system (DRS). There are a number of 
possible sensor and state characteristic value configurations and calculations. For example, 
the wheel speeds on outer and inner wheels can be compared. The recursive estimation of 

1 0 the conditional probability for the position of the vehicle is in different embodiments 
implemented for example with a non-linear filtering algorithm based on Bayesian 
estimation principles or an algorithm based on a non-probabilistic reasoning. 

Figure 1C shows schematically an embodiment of the system according to the 
invention, which embodiment preferably is used in vehicle positioning. The system in Fig 

15 1 C comprises at least two vehicle state characteristic sensors 1 00, wherein one sensor for 
example is a wheel speed sensor 101 and another for example is an inertial sensor 103. In 
different varieties the system may comprise more than one wheel speed sensor 101 and 
more than one inertial sensor 1 03. The system comprises further a dead reckoning unit 120, 
which calculates the relative position, i.e. the displacement or the movement, of the 

20 vehicle using the state characteristic sensor signal obtained from the wheel speed sensor 
101 and the sensor signal obtained from the inertial sensor 103. It should be understood 
that the dead reckoning system may be implemented using wheel speed sensors 101 and 
inertial navigation sensors 103 in different combinations. Alternatively, the relative 
position Ut could be estimated in a conventional manner using for example GPS position 

25 information. 

A first evaluation unit 130 is further comprised in the system. The first evaluation 
unit 130 iteratively updates a conditional probability density function (PDF) f x ^ ( x ) for 
the vehicle's position obtained in the previous iteration using a relative position . This 
results in the measurement update PDF f x ^ (x) . The calculation of the PDF 

^ A +1 |r, (*) ^ so k^tites un-modelled phenomena such as the drift in the inertial navigation 
system INS. The system further comprises a second evaluation unit 140, which updates the 
conditional probability density f x ^ (x) using the road map giving / X/+l |y i+( (x) . The road 
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map is preferably stored on a storage means 150, such as a digital map database, possibly 
with read-write possibilities for on-line map updating. 

This procedure is repeated as the system is running. In each iteration a new position 
estimate can be computed using either f x ^ Yf (x) or f x ^ (x) by means of a predetermined 

5 rule, preferably a maximum a posteriori rule or a least-squares error rule. Initialisation of 
the algorithm can for instance be done by using the course or area positioning from a 
cellular telephone equipment. 

Inference of further external positioning systems like GPS or cellular telephone equipment, 
can be incorporated in the measurement update performed by the second evaluation unit 
10 140. 



Mathematical Model 

The present invention will in this section of the description text be described using 
a mathematical approach, wherein the following state space model is used: 

15 x, +1 =x t +u,+w t (1) 
y t =h(x ( ) + e t (2) 
The state represents the vehicle's position on the map. At each iteration this is updated 
using w, , which is the relative movement obtained from a dead reckoning system DRS or 
an inertial navigation system INS. Drift in the DRS or the INS is modelled by additive 

20 independent identically distributed noise, so called i.i.d. noise, w t , with a probability 
distribution p Wi (♦) . The measurement, y , , consists of the non-linear function /*(♦) , 
evaluated at the current position, plus i.i.d. additive measurement noise, e t , with 
probability distribution p C( (•) . The i.i.d. additive measurement noise e t is assumed to be 
independent of w t . It can be noted that /*(•) is usually used to introduce map information 

25 in the model. In different embodiments /j(-)can also be used to introduce for example GPS, 
GSM, fixed point measurements or compass information. The normal vehicle embodiment 
of the invention is based on the assumption that the vehicle is driving on a road in the road 
network. In this case /?(•) for example represents the closest distance to the nearest road at 
time / , while y t represents a Active measurement of this distance at time / calculated using 

30 the road map. The difference y ( -h(x,) should ideally equal to zero in accordance with the 
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assumption but in reality thus corresponds to the measurement noise modelled by e t . The 
entity u further includes effects and phenomena from un-modelled or unmeasured 
movements or noise in the movement or state characteristic parameter value measurements. 



5 Let f x ^ (x) denote the conditional probability density function PDF for the state x t , given 

measurements for the vehicle position x up to the time t Choosing a probabilistic point of 
view in a Bayesian framework, the conditional probability density function PDF can be 
recursively updated in two steps: 
Firstly, a measurement update: 

10 USx)=lf.Sy,-m)f x ,\ y Jx) (3) 

c 

and secondly, a time update: 

/*,|r.M = \f Xt \Y^X)f v M-X^ t )d X (4) 

Using these expressions, the conditional probability density function, f x ^ (x) can 
be computed recursively at each iteration t given the information in the measurements up 

15 to the current iteration, denoted Y t . These expressions cannot, however, be evaluated 
analytically due to the non-linear nature of the estimation problem. Therefore, some kind 
of discretisation of the state space is necessary. Here we will outline two possible 
implementations: a point mass filter (PMF) and a sequential Monte Carlo filter (MCF). 
The latter is often also referred to as a particle filter. In both cases the algorithm has a 

20 recursive structure illustrated in Fig 2. 

. Fig 2 shows a schematic flow chart illustrating the recursive structure of a non- 
linear filter 200 comprised in embodiments of the invention and devised to generate an 
estimation of the position. The solution is in this example completely specified by the 
probability density function (PDF) as defined above. 

25 - Step 201 comprises a measurement update or a time update, in which new information is 
introduced into the solution. 

- Step 202 comprises calculating an estimate of the position, i.e. state x t and an associated 
error covariance. 
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- Step 204 comprises a time update, in which the particles are predicted based on the 
information from the DRS and the sensor error models. 

This recursive algorithm is then iterated repeatedly during operation of the positioning 
apparatus of the invention. 

5 

Implementation of inventive algorithm - embodiment using point mass filter (PMFi 

The invention can be implemented in various manners and is in one 
embodiment implemented by means of a so called point mass filter PMF, wherein the 
Bayesian problem is solved using a quantisation of the state space. With the PMF the state 
10 space, i.e. the map, is discretisised using a grid. If a uniform grid with N points and a 
resolution 5 is used the algorithm in accordance with equations (3)-(4) above can be 
expressed as follows: 

Initialisation: 

1 5 The computations are initialised with a discretised prior distribution function, p(x[ ) , 

which is modelled to express the prior knowledge of the true state, i.e. it can be rather non- 
informative or flat. 
Measurement update: 



-Update covariance information, or perhaps more strictly expressed covariance related 
information or uncertainty information: 



-Update conditional distribution, p(x\ \ Y t ) = -p e {y t - h{x\))p{x\ \ Y f _ x ) 

c ' 

20 -Compute estimate, x 1 ^ - arg max p(x\ \ Y t ) 



(5) 



(6) 



N 



(7) 



Time update: 



25 -Translate grid points, = x\ + u, i 



i = \,2,...,N 



(8) 



A' 

-Update conditional distribution, p(x\^ \ Y t ) = " */)/>(*/ I Y ,)$ 2 (9) 
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The time update comprises a translation of the grid points plus convolution of the 
probability density function with the error distribution of the relative movement. The 
measurement updates or re-computes the weights using the information in the new 
measurements, where c is a scaling factor. The position estimate is here chosen as a 
5 maximum a posteriori estimate. Other options, such as least squares estimation, are also 
possible. 

Implementation of inventive algorithm - embodiment using particle filter (TP 

In another, perhaps preferred embodiment, a particle filter also called a 

10 Monte Carlo filter (MCF) is used. Like in the previous embodiment, the Bayesian problem 
is solved using a quantisation of the state space. In the case of the particle filter, this means 
that the probability density function PDF is represented by a number of independent 
identically distributed i.i.d. samples referred to as particles. Fig 3 shows a 

schematic flow chart of steps comprised in a particle filter 300 in an embodiment of the 

15 invention.- Step 301 comprises a measurement update, in which new information is 

introduced into the solution. In the measurement update step a new importance weight is 
calculated for each particle based on the outcome of the measurement equations, when 
applied to the current particle. The weight can be considered as a sampled value of the 
posterior PDF. In order to keep the calculations sound in a probabilistic sense, the weights 

20 need to be normalised. 

- Step 302 comprises the calculating of an estimate and confidence parameters in the shape 
of an associated covariance. The approximate solution to the estimation problem is 
completely specified by the particle swarm. However, the primary interest is usually to 
obtain various estimates and confidence parameters. There are mainly two ways of 

25 calculating estimates, through expectation or through maximum a posteriori (m.a.p.). 
Expectation is easily performed by calculating a weighted sum over all particles. The 
maximum a posteriori m.a.p. estimate is also very straightforward - just pick the particle 
with the largest weight. The covariance matrix is obtained by calculating the second 
moment, if the estimate was obtained by expectation. The same procedure applied to a 

30 maximum a posteriori (m.a.p.) estimate yields a correlation matrix, since the m.a.p. 
estimate is not necessarily unbiased. 

- Step 303 comprises a test whether a resampling is needed. To make sure that the particles 
remain i.i.d. samples from the PDF, resampling has to be performed on a regular basis. 
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This is done by drawing samples with replacement until a certain number of new particles 
is obtained. The probability of resampling a specific particle at each draw is equal to its 
weight. The testing therefore in one embodiment comprises a comparison of the effective 
sample size with a predetermined threshold. The effective sample size is a measure of the 
5 particle weight variance. If the particles are true i.i.d. samples the variance is low (0) and 
when the set degenerates, the variance increases. The threshold for when resampling 
should be performed is preferably specified by the system designer. 

- Step 304 comprises the actual resampling also called bootstrap. 

- Step 305 comprises a time update. In the time updating step the particles that can be 

1 0 considered as candidates to the true position are translated using relative displacement, 
measured by the DRS, and realisations of the process noise. 
This algorithm is then repeated iteratively during operation of the invention. 



1 5 Carlo Filter MCF, which is also known as Bayesian bootstrap, can be described as follows. 
Initialisation: 



The particle filter PF algorithm is summarised as follows. If it is assumed 
that the initial state x Q is distributed according to p (•) the basic PF algorithm or Monte 




Measurement update: 



20 - Compute normalised weights, a> i = 



(10) 



N 



Compute position estimate, x, = arg max to ; 



(ID 



- Update the covariance information, C, = " )(*,' - 



(12) 



- Resample N times with replacement from {*' to obtain 



Time update: 



25 




- Translate all particles, x' M = x* + u , + w\ i = 1,2,...,N 



(13) 
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In the initialisation step a particle cloud consisting of N particles are randomly 
generated (i.e. sampled from the prior, p Xo (•) ). In the measurement update the particle 
weights are re-computed and the estimate updated. Here a maximum a posteriori estimate 
is used,but it should be noted that a minimum squares estimate can be used as well, 
5 possibly even preferably. In the measurement update the covariance information is updated 
in the natural way. As a last step, the particle cloud is re-sampled. In the time update the re- 
sampled particle cloud is translated and randomly disturbed by an artificial noise 
contribution. Note that the calculation of the estimate is embedded in the measurement step 
here and that the bootstrap step is performed on each iteration. 

10 

Map Database Handling 

The map database is one of the most fundamental components in map-aided 
positioning of the invention, and the map data handling is a vital part of the system. The 
map handling routines should be able to extract the information needed by the positioning 

1 5 algorithm from the database as quickly as possible. The measurement equations in the, for 
the sake of explanation, somewhat simplified model presented in the previous section use a 
single quantity provided by the map, namely the shortest distance from an arbitrary point to 
the road network. This can be obtained through a limiting search operation and minimising. 
These operations are crucial for the total functionality and performance of the algorithm 

20 and thus a lot of effort should be put on how to implement them as efficiently as possible. 
Advantageous embodiments comprise a data amount limiting function that operates to 
limit the amount of data that is processed in the time consuming optimising step. 

Fig 4 illustrates in a schematic flow diagram of how map information is 
retrieved in the measurement update step 400 of the algorithms described above in one 

25 embodiment of the invention. The exemplifying procedure 

- Step 402 comprises an incoming call from a measurement updating function or step in 
the position estimating procedure. 

- Step 404 comprises limiting the size of the search area in the map data base using e.g. 
the spatial extension of the particles and suitable confidence parameters.. 

30 - Step 406 comprises a loop of steps that is performed for each particle. Namely, in 

- Step 408 calculating the minimum distance to all road segments in the search area; 

- Step 410 selecting the minimum distance; and 
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- Step 412 calculating the angle of the corresponding road in relation to the co-ordinate 
system of the map. The calculation of the road angle is not needed for the simple 
embodiment discussed so far, but is utilised in further developed embodiments described 
below. 

5 After the steps of the loop 406-412 has been performed on each particle the procedure is 
returned with result parameters, comprising map data base specific information, to the 
measurement update procedure. 

Apart from performing the data access operations discussed above the map 
handling routines also comprises handling the update of the actual map database. The size 
10 of the map that is stored in the internal memory and operated on by the algorithm is limited 
by several factors. Therefore the system comprises functionality to indicate when the 
current map needs a refresh and to perform such an update without disturbing the real-time 
scheduling. 

15 P ositioning Example 

Fig 5a, 5b and 5c show on a schematic map an example of the inventive 
positioning system in operation. Fig 5a,5b,5c depicts a map with the topology of a path 
section 502, for example a road comprising bends and straight portions. A movable object 
504, for example a vehicle, has an initial position PA on the path. An initial position 

20 indication 506 in the shape of an area or a number of possible position indications, or as in 
some embodiments even a substantially exact initial position indication, is inputted as start 
information. Dependent on the initial position indication 506 the currently relevant map 
information is retrieved from a map database or some other map information source. Based 
on an application specific predetermined assumption or rule, for example that the true 

25 position of the movable object is on a path or a road, a number of possible position 

indications are extracted from the map information. In this example the possible position 
indications are positions on the current road portion 502, which in the figure is exemplified 
by one point on the road denoted 508. Thus, the possible position indications are 
coinciding with positions on the part of the road portions or are close to the road portions 

30 that are situated within the area of or the vicinity of the initial position indication 506. 

As the movable object moves along the path 502 the positioning system 
operates collecting state characteristic parameter values from for example relative position 
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sensors or inertial sensors of the movable object. Dependent on the state characteristic 
parameter values a relative position indication is calculated relative to the initial position 
indication, which preferably is used to delimit the number of possible position indications. 
Further, a number of position estimate candidates 510 are calculated dependent on the 
5 possible position indications and resulting in a number of clusters of such position estimate 
candidates 510 being substantially positioned close to the road at various distances from 
the true position of the movable object. Furthermore, these candidates are in different 
embodiments exactly or substantially corresponding to the possible position indications on 
the road. These candidates are exemplified in Fig 5a,5b,5c as clusters of dots 510. Each 

10 . position estimate candidate is then in accordance with predetermined criteria compared 
with one or more selected possible position indications, and a number of position estimate 
candidates are discarded and other are maintained dependent on a predetermined rule. A 
position estimate 512 is then calculated dependent on the state characteristic parameter 
values or is selected among the position estimate candidates in accordance with a 

1 5 predetermined position estimate selection rule, for example the candidate having the 
shortest distance to the road. Other more complex selection rules, for example involving 
more than one candidate are also conceivable. 

Preferably, new position estimate candidates or selections of the previous 
candidates are repeatedly obtained, retrieved or generated with a selectable periodicity, for 

20 example once in each estimation cycle. There are different possible ways of obtaining new 
position estimate candidates, for example each time randomly sampling a number, e.g. 100, 
of new candidates within a specific range from the path. Similarly, a new set of possible 
position indications 508 is repeatedly extracted from the map information, which if needed 
is repeatedly updated along with the movement of the movable object. 

25 Distinct features along the path, for example bends or curves, usually narrows 

the number of possible position indications and successively improves the calculated 
position estimate. Conversely, a movement along in-distinctive path portions such as 
straight paths generates little additional information to the estimation sequence and the 
calculation a position estimation may in that part not involve an improvement. Fig 5b 

30 shows the movable object 504 in a true position PB a distance down the followed path 502. 
At this stage of operation the movable object has passed a distinctive road feature in the • 
shape of a first bend 514 and the number of position estimate candidates have been 
reduced to a few clusters closer to the true position PB. A calculated or selected position 
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indication estimate 5 12 is here closer to the true positions as well. In Fig 5C, the movable 
object situated at a true position 44 has passed a second distinct road feature 518. The 
position estimate candidates 510 are reduced to a limited number in a cluster around the 
true position PC and a position estimate 512 is calculated to a position estimate that has 
5 converged to a position indication very close to the true position PC. Simulation and tests 
show that at this stage the position estimate obtained in accordance with the invention has a 
smaller error than a position indication obtained by normal GPS positioning. 

Further Developed Embodiment of the Positioning System 

In the following section a further developed embodiment of the invention and 
10 a more detailed description of the algorithm will be presented. This involves extensions of 
the state space model and additional features. The details presented in this section applies 
to the PF implementation. 

Estimation of the heading angle: 

1 5 The simple state space model used in the previous sections implicitly 

assumes that the true heading angle of the vehicle is known and included in the DRS 
output. This is however not always realistic, since a direct measurement of the absolute 
heading is usually not provided by a DRS ...In practical implementations the invention 
comprises dealing with relative heading angle changes or yaw rate measurements. This 

20 entails a modified state space model wherein the heading angle is estimated as well. 
State space model: 

By introducing the heading angle as a new state variable, this embodiment of the state 
space model can be written as follows 



State 




variables 






Position vector 




Heading angle (Yaw angle) 



25 
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where / (y/ f , w,) is a coordinate transformation between the DRS frame and the map 
5 frame. An additional measurement equation is introduced to deal with angular information: 

(15) 

10 The following notation is introduced above: Ay = T s v x ^.and A y/ = TJ¥ m . v x m is the 

longitudinal velocity and y ¥ m is the yaw rate measured by the DRS . T s is the sample 
period. 

The two functions h and <p are non-linear functions modelling the spatial information, i.e. 
1 5 the linear and the angular information, respectively, contained in the map. 

Estimation of sensor errors: 

The DRS measurements v x m and y ¥ m usually suffer from additive errors 
such as noise and offsets. In the model presented so far, it is assumed that these can be 
20 modelled with white noise processes. In order to improve the robustness of the filter, these 
sensor models are audited resulting in a further extension of the state space model. 

Sensor models: 

The embodiment described in this section assumes that the only sensors 
25 available for gaining information about linear and angular motions of the vehicle are the, 
normally already existing, ABS wheel speed sensors. However, it should be understood 
that other sensor configurations can be used, and that similar models can be derived for 
such cases. 
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(14) 
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The ABS sensors measure the angular velocity, co , of each wheel. If the true 
wheel radius is r, the linear velocity of the wheel is 

v = cor . 

5 (16) 

In the sequel the index convention will be such that rl means rear left wheel, fir means front 
right etc. 

10 The yaw rate, ¥ , can be calculated from the non-driven rear wheel speeds 

(this applies to a front wheel driven vehicle, but can be modified to fit in other 
configurations) 

L 9 

(17) 

1 5 where L is the rear wheel axle length. By plugging (16) into (17) we get 
L 

(18) 

If the wheel radii are known apart from an offset (caused by e.g. different tire 
pressure) the true wheel radii can be written 



20 r rr =r„+6 r 



r ri =r„+6 r +6 



(19a) . 



(19b) 

where r„ is the nominal wheel radius, S r is an absolute error (offset) and 8 is defined as 
25 S = r H -r rr , 

i.e. the wheel radii difference between left and right rear wheel. 



If (19) is inserted into (18) we get 
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* m °EZ2Lr a+ 2iLZ£bLs r -2L6. 
L L L 

(20) 

If the middle term is assumed to be small and if we use 

„, +fl> rf 
w 2 r ' 

5 (21) 

where v, „ denotes the nominal ("measured") longitudinal velocity, we obtain 

" r„L 

(22) 

Here denotes the nominal yaw rate, 
L 

which can be calculated from the measured angular rates and the nominal wheel radius. 
The longitudinal velocity can be written as 



v = V " + V " 
2 

1 5 Again using (16) and (1 9) we get 

CO„ + 0 W 0„-r co rl _ co r , „ 
v, = " 2 " r n + " 2 " 5, + ^-S 

(23) 

Using (21) this can be approximated by 
v, * v,, m + V -^S r + = v,,„, (1 + * + A) . 
20 (24) 



State space model: 
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By introducing two new state variables, the further developed state space model can be 
written as follows 



State 
variables 








Position vector 






Heading angle (Yaw angle) 






Rear wheel radii offset 






Absolute rear wheel radii 






difference 



As 



(25) 



where f(y/, , u s ) is a coordinate transformation. 



10 



(26) 



Initialisation: 

Since the algorithm is based on probabilistic inference, it is valuable to 
include as much prior knowledge about the position of the vehicle as possible. During the 
15 convergence process, it is important to limit the search area, i.e. to have a rough idea about 
the initial location of the vehicle. This can be obtained e.g. by using positioning services in 
a cellular network, like GSM. When the base stations control the communication between 
handsets in the network, rough position estimates (areas) are used to deduce how to 
distribute transmission power. These areas can be retrieved from a Mobile Positioning 
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Service (MPS) and forwarded to the inventive positioning system in order to define the 
initial search area. 

Another possibility used in some embodiments is to use a position indication 
from a GPS receiver, along with a sufficiently large confidence region, to limit the search 
5 area. However, this of course implies that a GPS receiver is included or communicatively 
coupled to the system. 

Furthermore it is possible to initialise the search area manually, if the 
approximate starting location is known, or by specifying an absolute position. The latter 
might be the case if the system is used in public transports, taxi services or car rental 
1 0 sendees. Then the absolute position can be provided by a transponder when the vehicle 
passes a known location, e.g. the gates to the garage driveway or another fixed station as 
exemplified above. 

The initial search area serves two purposes: Firstly it defines the extension of 
the prior distribution, i.e. the area that has to be populated with particles, and secondly it 
1 5 limits the amount of map data that has to be processed. 

When GSM positioning is used for initialisation, the procedure is as follows: 
~ An area is requested from MPS. 

- The area is used to model the prior distribution function. 

- Samples (particles) are drawn from the prior. 

20 - The filtering starts using a limited map, chosen with respect to the MPS area. 

When the system is started manually basically the same steps as in the GSM 
case are used except that the user specifies the initial search area. Alternatively an external 
source or the user can be used to pinpoint the absolute position. Even in such a case it 
might be preferred to use a smaller area centred at the given position to ensure robustness 
25 of the system. 

When GPS is used for initialisation, the procedure is as follows: 

- A fixed position is requested from GPS. 

- The fixed position is used, along with confidence parameters, to model the prior 
distribution function. 

30 - Samples (particles) are drawn from the prior. 

- The filtering stalls using a limited map, chosen with respect to the GPS fix and the 
confidence parameters. 
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Additional Features of Embodiments 

The main tuning parameters of the particle filter PF are the process and 
measurement noise. Here lies the information about how data should be fused into the 
algorithm. The process noise should reflect the actual error/uncertainty in the relative 
5 displacement (i.e. the inertial sensor signals), but has also an important role in order to 
prevent unwanted particle clustering. This phenomenon arises when the particle swarm 
degenerates to multiple copies of only a few distinct samples, which leads to poor 
exploration of the state space. By adding an artificial jittering noise or by exaggerating the 
process noise, the particles are separated and the "sticky" tendency is reduced. 

10 Some embodiments of the invention comprises steps or functions devised to 

spread the particles. During the initial phase of the execution, it is more important to 
maintain an efficient exploration of the state space, rather than using physically correct 
models for measurement noise and other model parameters. This means that it might be 
necessary to "sacrifice" particles to ensure that the cloud of particles is well dispersed. 

1 5 There are several ways of achieving a more uniform particle density. One way is to loosen 
the punishment on measurement errors, i.e. to increase the measurement noise. Another 
way is to spread particles along the directions of the roads. The latter can be done by 
correlating the process noise components to the heading angle of each particle and 
exaggerating the variance. This procedure will corrupt the individual particle, but hopefully 

20 it will make sure that the true state survives the initial phase. 

For performance reasons it is sometimes fruitful to modify the algorithm 
during a few recursions. For example it is sometimes beneficial to change the noise 
variance on certain conditions. Another modification is to turn off some of the 
measurements during a single measurement update. This could be useful when the vehicle 

25 is making a sharp turn in a crossroads and the ambiguity in the road angle is large. In such 
a case the angular information provided by the map should not be relied upon. 

Since the characteristics of the convergence process differ from those of the 
post-convergence filtering, it is in some embodiments provided for changing the filtering 
strategy when convergence is reached. This event is referred to as a mode transition and is 

30 controlled by a certain condition. For example, two modes or more can be used. If, for 
example, the vehicle starts driving straight ahead, one mode is to focus on distributing the 
particles along the straight ahead roads. When the vehicle makes a sharp turn, the particles 
are usually concentrated on certain areas of the map, i.e. the cloud has transformed into 
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clusters close to locations on the map where it is possible to make the current type of turn. 
Now, the main task is no longer to ensure that the particles are well distributed, and 
therefore a transition to a second mode with less spreading might be appropriate. After 
further driving, all but one cluster have died out and the condition for convergence is 
5 fulfilled. Then a second change of mode (to the post-convergence mode) can be performed. 
In order to increase the PF reliability and robustness it should be 
accompanied by divergence surveillance, which should be able to tell whether the filter has 
diverged or not within a reasonable time and with a low false alarm rate. One way of 
solving this is to use a change detector on some suitable quantity. If divergence is detected, 

1 0 the filter should perform a soft reset. 

As has been mentioned above, different embodiments are combined with 
GPS positioning. An interesting application of map-aided positioning in accordance with 
the invention is to use it together with a conventional GPS in order to improve accuracy, 
reliability and possibly also bandwidth. The natural way of merging these two positioning 

1 5 techniques is to utilise the sensor fusion structure of the PF and introduce the GPS position 
as an extra measurement Furthermore, this measurement should only be enabled when the 
GPS fix is reliable and therefore information about timing and integrity should be 
available. 

It should be understood that the system according to the invention may be 
20 implemented on a number of different (mobile) platforms. Hence the positioning system 
can run on, for example, a portable or handheld PC itself constituting the movable object or 
having an interface to a movable object such as a vehicle/train/robot, giving the user 
increased freedom to choose which platform to use. Thus, the user does not have to choose 
the platform pre-installed or recommended by the vehicle/train/robot manufacturer. 
25 Further, the positioning system cost is likely to be considerably reduced due to the 

increased competition among the suppliers of such platforms. Thus the invention facilitates 
more general implementation possibilities than current navigation systems, whereby the 
positioning system becomes a portable software system rather than a hardware system. 
Further, this opens up for other mobile positioning services than positioning for vehicles 
3 0 such as in-door positioning (for robots). 

It should also be noted that the system according to the invention may be integrated 
with the standard sensor suite in the vehicle/train/robot (e.g. wheel speed sensors, steering 
angle sensors, and accelerometers) and be used by an on-board computer keeping track of 
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service intervals, driving style, average mileage etc. It can also be used in so-called self- 
calibrating sensors e.g. to remove offsets and drifts in yaw rate gyros and accelerometers. 
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1 . A positioning method for determining the position of a moveable object, comprising 
the steps of: 

5 - receiving as an input an initial position indication; 

- receiving as an input topology information dependent on said initial position 
indication, said topology information including a plurality of possible position 
indications; 

- receiving as an input a moveable object state characteristic parameter value; 

10 - calculating a relative position indication relative to said initial position indication 
dependent on said moveable object state characteristic value; 

- generating a plurality of position estimate candidates dependent on a said possible 
position indications and on said relative position indication; 

- selecting a position estimate indication among the position estimate candidates and 
1 5 dependent on a predetermined selection rule. 

2. A positioning apparatus for determining the position of a movable object, comprising: 

- an input for an initial position indication; 

- an input for topology information dependent on said initial position indication, said 
20 topology information including a plurality of possible position indications; 

- an input for a moveable object state characteristic parameter value; 

- a calculation stage configured to calculate a relative position indication relative to 
said initial position indication dependent on said moveable object state characteristic 
value; 

25 - a calculation stage configured to generate a plurality of position estimate candidates 
dependent on a said possible position indications and on said relative position 
indication; 

- a selection stage configured to select a position estimate indication among the 
position estimate candidates and dependent on a predetermined selection rule. 

30 

3. The positioning method or apparatus as recited in any of the preceding claims, wherein 
the initial position is indicated as a limited geographical area. 
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4. The positioning method or apparatus as recited in any of the preceding claims, wherein 
the initial position indication is obtained from a wirelessly communicated positioning 
service. 

5 5. The positioning method or apparatus as recited in any of the preceding claims, wherein 
the initial position indication is obtained from a GPS receiver. 

6. The positioning method or apparatus as recited in any of the preceding claims, wherein 
the initial position is input manually. 

10 

7. The positioning method or apparatus as recited in any of the preceding claims, wherein 
the initial position indication is obtained via a transponder situated at a fixed location. 

8. The positioning method or apparatus as recited in any of the preceding claims, wherein 
1 5 said topology information is obtained from map information of a map information 

source. 

9. The positioning method or apparatus as recited in claim 7, wherein said map 
information source is a map database stored on a data storage. 

20 

10. The positioning method or apparatus as recited in claim 7, wherein said map 
information is received from a remote a map source. 

1 1 . The positioning method or apparatus as recited in any of the preceding claims, wherein 
25 said state characteristic parameter values are received from a relative position sensor of 

the movable object. 

12. The positioning method or apparatus as recited in any of the preceding claims, wherein 
said state characteristic parameter values are received from an inertial sensor of the 

30 movable object. 

13. The positioning method or apparatus as recited in any of the preceding claims, wherein 
said relative position indication is calculated as the distance and/or the direction the 
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movable object has moved from the initial position indication. 



14. The positioning method or apparatus as recited in any of the preceding claims, wherein 
said generation of position estimate candidates comprises the step of repeatedly 
5 selecting a limited set among current position estimate candidates. 



15. The positioning method or apparatus as recited in any of the preceding claims, wherein 
said generation of position estimate candidates comprises the step of randomly 
selecting position candidates. 

10 

16. The positioning method or apparatus as recited in any of the preceding claims, wherein 
said position estimate indication is selected as the position estimate candidate having 
the shortest distance from one of the currently possible position indications. 

15 17. The positioning method or apparatus as recited in any of the preceding claims, wherein 
said calculation of position estimate candidates is performed by means of an adaptive 
filter. 



18. The positioning method or apparatus as recited in any of the preceding claims, wherein 
20 said movable object is a wheeled vehicle or a robot. 

19. The positioning method or apparatus as recited in any of the preceding claims, wherein 
said movable object is a track vehicle, such as a train or tram. 

25 20. The positioning method or apparatus as recited in any of the preceding claims, being 
configured to implement map-matching in a GPS based positioning/navigation system. 

21 . The positioning method or apparatus as recited in any of the preceding claims, being 
configured to implement vehicle positioning using MPS. 

30 

22. The positioning method or apparatus as recited in any of the preceding claims, being 
configured to monitor the performance of a GPS based navigation system. 
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23. The positioning method or apparatus as recited in any of the preceding claims, being 
configured to monitor a navigation data sensor, such as an INS or an RDS sensor. 

24. A computer program product comprising computer program code portions configured 
5 to direct a data processing system to perform the steps and functions as recited in any 

of the preceding claims. 
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